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fuzzy  logic  control  were  evaluated  in  simulation  and  with  hardware  in  the  loop  in  the 
University  of  Washington  Control  Systems  Laboratory.  The  plant  model  and  the 
Integrated  System,  Inc.,  AC100-C30  real  time  control  prototyping  system  were  first 
validated  using  a  FID  controller,  which  was  also  used  as  a  comparison  for  the 
performance  of  various  fuzzy  logic  controllers.  The  control  objective  was  to  slew  the 
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Chapter  1:  Introduction 


l.l  Background 

Robots  have  become  common  place  in  today's  industrial  environment  Their  ability  to 
perform  repetitive  tasks  with  precision  has  proved  their  place  in  industry.  As  with  any 
relatively  recent  technology,  however,  there  continue  to  be  problems  as  well  as  advances. 
Although  robots  have  shown  that  they  are  useful  as  well  as  cost  effective  in  many 
industries,  the  size,  weight  and  cost  of  current  robots  has  excluded  them  from  many 
tasks.  To  increase  the  performance,  as  well  as  reduce  the  price,  smaller  and  lighter  robots 
are  being  developed  and  their  performance  evaluated.  This  reduction  in  size  and  weight 
introduces  the  problem  of  structural  rigidity  for  the  robot  arm  or  arm  segments. 

When  controlling  a  robot  arm  there  are  two  major  performance  criteria:  accuracy 
and  speed.  Using  a  rigid  arm.  it  is  generally  an  easy  task  to  slew  a  manipulator  from 
point  A  to  point  B  within  a  reasonable  time.  When  a  lighter,  more  flexible  arm  is  used, 
however,  the  dynamics  of  the  arm  may  be  excited  when  the  same  slew  time  is  used.  Widi 
this  added  complication,  a  flexible  robot  is  often  unable  to  complete  a  given  task  as 
quickly  as  a  more  sturdy  manipulator. 

Another  problem  for  the  flexible  arm  is  a  changing,  or  unknown  plant  or  payload. 
Although  this  problem  is  not  isolated  to  flexible  manipulators,  the  more  excitable 
dynamics  often  magnify  the  change  from  the  design  point  To  give  the  robustness  that 
this  situation  requires,  fuzzy  logic  is  employed  for  the  development  of  the  controller 
logic.  Fuzzy  logic  based  controllers  are  able  to  offer  this  robustness  with  the  convenience 
of  intuitive  thought  and  without  the  large  memory  requirement  of  lookup  tables  or  the 
large  computation  requirement  of  formula  based  solutions  [2]. 


1.2  Problem  Definition 

In  a  paper  from  the  University  of  Akron  [4],  a  control  law  was  presented  in  simulation 
which  consisted  of  a  fuzzy  logic  controller  plus  a  nonlinear  effects  negotiator  for  a 
flexible  robot  manipulator.  In  this  model  the  nonlinear  effects  negotiator  was  used  to 
cope  with  the  uncertainty  of  the  mathematical  model.  They  used  an  error  response  plane 
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method  to  obtain  fuzzy  control  rules  and  investigated  the  degree  of  overlap  of 
member^p  functions  for  the  fuzzy  rules.  They  used  a  5x5  rule  matrix  to  obtain  these 
results  and  sensed  bodi  tip  displacement  and  joint  angle.  Their  results  showed  that  the 
fuzzy  logic  controller  was  robust  for  model  uncertainties,  nonlinearities,  and 
disturbances. 

The  objectives  of  the  research  conducted  for  this  thesis  were  to:  a)  design  a  fuzzy 
logic  controller  to  minimize  the  time  for  a  known,  flexible  plant  and  a  known  payload  to 
slew  a  given  distance,  b)  verify  the  robustness  with  varying  payloads  and  plants,  and  c) 
validate  the  results  with  hardware-in-the-loop  realization  of  the  controller  logic. 
However,  unlike  the  work  at  the  University  of  Akron,  no  nonlinear  effects  negotiator  will 
be  used  and  only  joint  angle  sensing  is  available.  The  known  plant  and  payload  case 
performance  was  Hrst  established  through  the  use  of  a  proportional,  integral,  and 
differential  (PID)  controller,  a  customary  approach  to  robot  arm  control.  Both  of  the 
controllers,  as  well  as  the  varying  plants  and  payloads  were  implemented  in  hardware  on 
the  University  of  Washington  Control  System  Laboratory  robot  arm  test  facility  [6]. 


1.3  System  Configuration 

Each  component  of  the  hardware  of  the  robot  arm  and  equipment  used  to  complete  the 
thesis  is  described  in  this  section.  The  general  system  includes  a  torque  motor  to  drive 
the  system,  a  manipulator  arm  that  attaches  to  the  motor,  and  an  endpiece  that  the  arm 
attaches  to.  The  endpiece  is  then  floated  on  a  large  granite  table  using  compressed  air, 
thus  minimizing  friction.  Another  benefit  of  this  implementation  is  that  torsional 
deformations  of  the  arm  are  minimized. 


Figure  1.1  Experimental  Configuration 


1.3.1  Torque  Motor 

A  brushless  DC  torque  motor  from  Aeroflex,  part  number  TQ40W-1  IP,  is  the  only 
actuator  for  the  system.  The  motor  has  a  limited  range  of  sensitivity,  but  is  100% 
sensitive  for  +/-  20  degrees  and  is  75%  sensitive  for  +/-  60  degrees.  The  peak  torque  is 
260  inch  ounces.  The  dimensions  include  an  outer  diameter  of  4  inches,  an  inner 
diameter  of  .375  inches  and  a  width  of  1.5  inches.  The  motor  weighs  51  ounces. 


1.3.2  Manipulator  Arm 

The  original  design  manipulator  arm  has  a  height  of  .0381  m,  a  width  of  .003177  m,  and 
is  made  of  aluminum  6061.  This  aluminum  has  a  stiffness,  E,  of  70  x  10^  N/m^  and  the 
beam  has  a  moment  of  inertia  of  1.02  x  10'^^  m^.  The  actual  length  is  1.029  m  with  an 
effective  length  of  .96583  m. 
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1.3.3  Endpiece 

The  original  design  endpiece  is  a  7  inch  diameter,  .6  inch  thick  Plexiglas  disk.  Three 
holes,  starting  with  diameters  of  .6  inches  on  the  bottom  and  angling  into  .2  inches  at  the 
top,  allow  compressed  air  to  be  expelled  in  order  to  allow  the  disk  to  float  The 
secondary  endpiece  is  also  a  disk  of  the  same  dimensions,  but  it  also  includes  a  mass  of 
192  ounces. 


1.3.4  Granite  Table 

A  4  feet  by  8  feet  by  9.75  inches  granite  table  is  the  platform  for  the  robot  atm.  The  top 
has  been  polished  to  be  smooth  and  flat 

1.3.5  Optical  Encoder 

A  Hewlett  Packard  HEDS-6010, 3  channel,  56mm,  high  resolution,  incremental,  optical 
encoder  is  used  to  read  the  angular  displacement  of  the  arm,  theta,  from  die  motor.  The 
encoder  consists  of  an  LED  source  and  lens  which  transmits  collimated  light  from  the 
emitter  module  through  a  metal  co<te  wheel  and  phase  plate  into  a  detector  lens.  The 
shaft  contains  1024  cycles  per  revolution  which  allows  a  high  level  of  resolution.  A 
supply  voltage  of  between  -0.5  and  7  volts  is  needed. 


1.3.6  Quadrature  Decoder 

The  Hewlett  Packard  HCTL-2020  chip  uses  a  16-bit  counter  to  perform  the  quadrature 
decoder,  counter,  and  bus  interface  function. 


1.3.7  Matrixx/SystemBuild  Software 

Computer  analysis,  simulation,  and  code  generation  were  performed  using  Matrixx  and 
SystemBuild  software  by  Integrated  Systems  Inc.  (ISI).  These  linear/non-linear 
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applications  were  run  on  a  SPARCstationlO  by  Sun  Electronics.  SystemBuild,  which 
uses  Matrixx  as  its  mathematics  platform,  performs  time  simulations  as  well  as  generates 
C  code  to  be  used  for  real  time  implication.  SystemBuild  incluctes  an  interactive 
animation  package  which  allows  inputs  and  outputs  from  die  system  to  be  examined  and 
changed  during  real  time  application. 


1.3.8  AC100-C30 

The  AC100-C30  is  an  ISI  hardware/software  interface  which  is  embodied  in  a  Dell  466/m 
computer.  When  connected  to  the  SPARCstation  by  ethemet,  the  AC100-C30  is  able  to 
receive,  compile,  link,  and  run  the  C  code  generated  by  SystemBuild.  If  desired,  the 
ethemet  is  also  able  to  carry  the  inputyoumut  data  from  the  AC100-C30  back  to  the 
SPARCstation  where  it  may  be  observed  u^g  the  interactive  animation.  This  feature  is 
not  required,  however,  for  the  system  to  run.  Once  the  C  code  has  been  downloaded  to 
the  AC1(K)-C30,  the  system  can  run  without  the  presence  of  the  SPARCstation. 


Chapter  2:  Model  Structure 


2.1  Overview 

In  control  systems  engineering,  it  is  not  uncommon  for  large  amounts  of  time  to  be 
wasted  due  to  inexact  plant  models.  After  time  has  been  spent  creating  a  simulation,  due 
to  inaccuracies  in  the  system  model,  the  control  system  often  will  not  woik  on  the  actual 
hardware.  There  are  two  methods  that  may  be  used  to  avoid  this  situation;  system 
verification  and  robust  design.  If  the  hardware  is  known  and  available,  tests  may  be 
performed  to  test  the  dynamic  characteristics  and  compare  the  results  to  the  system 
model.  If  the  exact  hardware  is  either  unknown  or  unavailable,  however,  this  method  will 
not  work  and  a  large  amount  of  robustness  may  have  to  be  designed  into  the  control  law. 

Because  of  this  plant  uncertainty,  there  has  been  an  increase  in  research  focused 
on  fuzzy  rule-based  control,  based  on  fiizzy  logic  theory  [4].  After  the  success  of  fiizzy 
logic  control  in  other  engineering  areas,  further  work  demonstrated  the  ability  of  fuzzy 
logic  to  control  mobile  or  rigid  robots  (4].  Hnally,  research  performed  at  The  University 
of  Akron  shows  in  simulation  that  fuzzy  logic  could  control  a  flexible  manipulator  with  a 
large  amount  of  robustness.  These  results  were  not  validated  with  hardware-in-the-loop. 


2.2  Plant  Model 

Theoretical  modeling  and  verification  of  the  plant  model  has  been  accomplished  for  a  2 
link  ai  i  by  Oakley  at  Stanford  University  [S]  and  for  a  1  and  2  link  arm  by  Evers  at  the 
University  of  Washington  [1].  This  research  uses  the  1  link  arm  model  developed  by 
Evers.  Both  Oakley  and  Evers  use  a  Lumped  Spring  Mass  Damper  (LSMD)  modeling 
technique  where  the  distributed  effects  of  elasticity,  inertia,  and  damping  are 
approximated  by  a  finite  number  of  torsional  springs,  dampers,  link  elements,  hub 
elements,  and  tip  elements.  The  inertial  and  kinematic  parameters  of  the  manipulator 
elements  were  developed  analytically  and  used  in  the  mathematical  model.  Damping  was 
determined  experimentally  and  inserted  back  into  the  analytical  model. 

There  are  6  assumptions  used  in  the  model: 
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1.  In  plane  bending  and  motion 

2.  Itteal  pinned  joint  action 

3.  No  frictional  effects 

4.  Small  in  plane  deflection 

5.  Ideal  linear  amplifier  characteristics 

6.  Ideal  non-linear  motor  characteristics  [1] 

Using  these  assumptions,  non-linear  dynamic  models  were  developed  for  the  two 
link  manipulator  using  the  Lagrange  method  for  low  order  models.  Tte  resulting  non¬ 
linear  models  were  then  adapted,  by  Evers,  to  the  single  link  arm.  The  non-linear  models 
for  the  single  link  arm  are  of  the  form: 


Miz)u  +  V(z,«) +Rz  +  Kz^Tt 

(2.1) 

i|*"l 

“i. 

(2.2) 

*■1 

U  ~  1 

(2.3) 

(2.4) 

T  =  T, 

(2.5) 

where  M  contains  the  mass  and  inertia  manipulator  properties,  V  contains  the  Coriolis 
and  centripetal  terms,  R  contains  the  coulomb  torsional  damping,  K  represents  the 
torsional  stiffness,  T  represents  the  torque  distribution  matrix,  and  r  represents  the  input 
torque.  The  remaining  physical  properties  are  (tefined  in  Figure  2.1. 

These  non-linear  equations  were  then  linearized  using  Taylor’s  expansion.  The 
resulting  linear  equation  of  motion  is  of  the  form: 

MAz  +  RAz + AAz  =  TAt  (2.6) 

The  result  of  the  plant  representation  is  a  state  space  system  with  a  single  input 
and  42  ouq)uts.  x  represents  the  states,  Ar  the  input,  and  y  the  ouq>uts.  The  ou^uts 
consist  of  the  40  states  as  well  as  2  local  coordinates  which  are  not  used  in  this  research. 
The  input  is  the  torque  generated  by  the  control  law.  The  linear  model  in  standard  state 
space  convention  is: 


(2.7) 


9 


In  the  model,  the  manipulator  aim  may  be  sectioned  into  as  many  finite  elements 
as  the  user  deems  necessaiy  to  give  an  accurate  response  of  the  important  modes  (Figure 
2.2).  Model  reduction  may  then  be  used  to  obtain  an  accurate  lower  order  model  In  the 
work  by  Evers  it  was  concluded  that  only  the  first  3  modes  would  be  impoitant  for  the 
system  and  that  a  finite  element  grid  of  20  members  would  accurately  represent  these  3 
modes.  For  a  20  member  bar  this  results  in  40  states.  The  states  of  the  system,  shown  in 
Figure  2.1,  include  the  angle  at  the  shoulder  in  radians,  the  velocity  of  this  angle  change 
in  radians  per  second,  the  distances  that  each  of  the  finite  element  members  have 
displaced  due  to  the  flexibility  in  the  arm  in  radians,  and  the  velocity  of  these 
displacements  in  radians  per  second.  The  eigenvalues  of  the  resulting  system  show  that 
the  system  has  38  stable  poles  and  2  neutrally  stable  complex  poles.  The  first  twelve 
modes,  corresponding  to  the  first  25  poles,  are  diown  in  Figure  2.3.  The  first  eight  of 
these  modes  are  at  12  Hz,  37  Hz,  73  Hz.  101  Hz,  102  Hz,  103  Hz,  106  Hz,  1 12  Hz,  128 
Hz,  and  154  Hz.  The  remaining  15  poles  are  all  stable  and  sit  on  the  real  axis  as  far  out 
as  144,000  Hz. 

The  computer  program  used  to  generate  the  plant  model,  the  derivation  of  the 
mathematical  model,  a  listing  of  poles  and  zeros,  as  well  as  bode  and  root  locus  diagrams 
are  shown  in  the  appendices. 

2.3  Model  Reduction 

The  state  space  model  developed  from  the  20  piece  finite  element  grid  results  in  a  40  by 
40  matrix.  Although  this  provides  an  accurate  representation  of  the  actual  system,  it  is 
undesirable  to  use  a  system  this  large  for  control  design  studies  due  to  the  inefficiencies 
caused  by  the  large  number  of  calculations  required  for  a  matrix  of  this  size.  To  make  the 
design  process  more  efficient,  the  state  space  model  is  reduced  to  10  states. 
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There  are  many  methods  that  are  available  fen  model  reduction,  however,  most  of 
these  methods  have  a  restriction  that  die  system  be  completely  stable.  SiiK:e  the  robot 
arm  contains  a  pair  of  neutrally  stable  poles  these  methods  are  not  immediately  available 
for  use.  To  bypass  this  problem  the  state  matrix  is  partitioned  to  separate  the  stable  poles 
from  the  nonstable  poles.  By  doing  this,  the  stable  matrix  may  be  reduced,  then  the 
unstable  part  of  the  matrix  may  be  added  back  on. 


Real 

Figure  2.3  Open  Loop  Poles  of  the  40  State  System 

The  reduction  method  used  for  this  system  is  the  truncation  of  a  balanced 
realization.  A  balanced  realization  balances  the  ease  of  control  against  the  ease  of 
observation.  To  do  this  the  singular  value  decompositions  of  the  observability  grammian, 
Q,  and  the  controllability  grammian,  P,  are  combined  to  result  in  a  single  singular  value 
decomposition.  This  is  then  used  to  form  a  transformation  for  the  system  widi  balanced 
observability  and  controllability.  Once  the  system  is  balanced,  the  smallest,  and, 
therefore,  hardest  to  observe  or  control,  eigenvalires  are  eliminated.  This  leaves  a  smaller 
system  with  only  the  hardest  to  control  and  observe  states  missing.  This  can  cause  a 
problem,  however,  if  the  hard  to  control  or  observe  states  h^pen  to  be  the  states  of 
importance.  The  remaining  10  poles  of  the  reduced  system  are  shown  in  Figure  2.4.  The 
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poles  at  the  origin  remain  unchanged,  while  the  remaining  8  poles  have  moved  off  of  the 
real  axis  and  have  become  4  sets  of  complex  poles.  The  flexible  modes  that  remain  are  at 
37Hz.lllHz,  21SHZ,  and  370  Hz.  Although  some  of  the  modes  from  the  full  model 
have  been  removed,  the  second  flexible  mode  at  37  Hz  remains.  From  experimentation, 
it  is  this  mode  that  is  most  easily  excited.  Thus  the  mode  that  is  the  most  relevant  to 
implementation  remains  in  the  model. 


poles  of  reduced  system 
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Figure  2.4  Open  Loop  Poles  of  Reduced  Model 


2.4  Digitization 

Once  the  system  is  reduced,  the  state  space  is  transformed  from  continuous  to  digital 
form.  The  Tustin's  method  is  used  with  a  sampling  time  of  .01  seconds. 


Chapter  3:  Tests  and  Results 


3.1  Overview 

The  system  model  as  well  as  the  hardware  and  software  described  in  Chapter  2  were  new 
to  the  University  of  Washington  System  Controls  Laboratory.  Because  of  the  inherent 
problems  associated  with  any  new  hardware  or  software  system,  a  well  understood  test 
model  was  first  used  to  validate  the  system  model  and  ensure  proper  connections 
between  the  software  and  the  hardware.  To  accomplish  this  objective  a  proportional, 
integral,  and  derivative  (PID)  controller  was  developed.  After  this  was  done  the  fuzzy 
logic  controller  was  developed.  The  fuzzy  logic  controller  was  designed  and  flrst  tested 
using  the  verified  plant  model,  but  was  then  tested  on  other  unknown  plants. 


3.2  Feedback  System 

Both  controllers  were  developed  using  negative  feedback  of  the  state  theta  from  the  plant 


Figure  3.1  Feedback  Configuration 


When  slewing  a  flexible  arm  there  is  a  trade  off  between  two  slewing  techniques.  The 
first  possibility  is  to  slew  the  arm  as  fast  as  possible  with  a  step  input  Assuming  that  the 
motor  is  able  to  accommodate  this  command,  the  rapid  onset  of  the  movement  will  most 
likely  excite  the  flexible  modes  of  the  arm.  These  extra  dynamics  will  increase  the  woik 
load  of  the  controller  and  may  increase  the  time  to  settle  at  the  desired  location.  The 
other  possibility  is  to  slew  the  arm  very  slowly  as  to  not  excite  any  flexible  modes  of  the 
arm.  This  is  not  a  hard  control  task,  but  the  response  is  also  very  slow.  To  maximize  the 
advantages  of  both  possibilities  while  easing  the  strain  of  discontinuities  on  the  motor. 
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the  reference  theta  used  to  slew  the  flexible  arm  is  a  smoodi  ramp  (Figure  3.2)  used  by 
Oakley  [5].  The  equation  for  the  reference  input  is 

e,=fe;„-e«.-H6T’-i5r+ioT>i+e.^  o.i) 

T  =  —  (3.2) 

TiUw 


Tslew  is  the  time  allowed  for  the  reference  theta  to  move  from  the  initial  position  to  the 
final  position. 


time 

Figure  3.2  Smooth  Ramp  Reference  Theta  to  15  Degrees,  Tslew=l  sec 


3.3  PID  Controller  in  Simulation 

The  PID  controller  for  the  single  link  manipulator  was  designed  as  a  digital  system  using 
root  locus  and  time  response  to  determine  the  gains. 
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Table  3.1  PID  Gains 


PID< 

Sains 

Proportional 

0.3 

Integral 

0.1 

Derivative 

0.6 

These  gains  provide  a  controller  with  a  smooth  torque  output  (Newton-meters  converted 
to  volts  as  1.9208  volts  per  Nm)  diat  in  simulation  is  able  to  slew  the  arm  to  10  degrees 
with  a  steady  state  error  of  .3  percent,  a  rise  time  of  .58  seconds,  and  a  S  percent  settling 
time  of  4.5  seconds.  The  overshoot  for  this  system  is  16  percent 


For  a  15  degree  slew  these  numbers  change  to  a  steady  state  error  of  0.7  percent,  a  rise 
time  of  0.58  seconds,  a  settling  time  of  4.5  seconds,  and  a  15  percent  overshoot  The 
‘chatter’  in  both  the  torque  and  theta  response  is  a  result  of  the  quantization  of  the  system. 
If  the  test  is  run  without  simulating  the  hardware  interface,  this  result  is  not  observed. 


radians  volts 


15 


time 


Rgure  3.4  PID  Simulation  Torque  10  Degree  Slew 
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3.4  PDD  Controller  In  Hardware 

Using  the  PID  controller  on  the  hardware  gave  similar  results  to  those  obtained  in  the 
simulation.  For  a  10  degree  slew  the  steady  state  error  increased  from  0.3  percent  to  5.73 
percent  and  the  rise  time  rose  from  0.58  seconds  to  1.55  seconds.  The  overshoot, 
however,  decreased  from  16  percent  to  10.57  percent  and  the  settling  time,  accounting  for 
an  initial  displacement  of  the  manipulator  arm  rose  from  4.5  seconds  to  8  seconds.  The 
comparisons  are  similar  for  the  15  degree  slew.  The  steady  state  error  increased  from  .7 
percent  to  2.7  percent,  the  rise  time  increased  from  0.58  seconds  to  2.81  seconds,  and  the 
settling  time  increased  from  4.5  seconds  to  7.5  seconds.  As  with  the  10  degree  slew  case, 
however,  the  overshoot  decreased  from  15  percent  to  5.71  percent 

For  all  of  the  performance  criteria  except  the  percent  overshoot  the  result  is  not 
surprising.  In  general,  some  degradation  in  performance  from  simulation  to 
implementation  is  expected.  The  reduction  in  percent  overshoot  may  be  attributed  to  a 
combination  of  the  modeling  of  damping  and  stiffness  of  the  manipulator.  These  values 
in  the  model  have  been  determined  experimentally  and  are  subject  to  being  updated. 


Theta  10  Degree  Slew 
que 


10  15 

me 
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10  Degree  Slew 


volts  radians 
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3.5  Fuzzy  Logic  Controller  Theory 

A  fiizzy  logic  controUer  is  a  S-step,  rule  based  system  that  is  able  to  combine  in  parallel 
an  array  of  inputs,  and  develop  a  single  output  that  is  unique  to  the  specific  inputs.  These 
inputs  are  based  on  qualitative  information  and  then  are  connected  with  each  other  using 
a  preset  Icnowledge  base.'  The  input  is  then  evaluated  against  the  'fuzzy  data'  using 
'membership  curves'  to  determine  the  appropriate  ouq>uL 

A  fuzzy  logic  system  contains  no  true  states,  but  consists  of  a  database  containing 
definitions  of  the  inputs  and  outputs.  The  database  includes  the  type  of  data,  the  range  of 
acceptable  values,  and  the  membership  functions  to  be  applied  to  the  data.  The  type  of 
data  refers  to  crisp  versus  fuzzy  which  is  best  explained  by  example.  When  considering  a 
summer  day.  people  have  varying  opinions  as  to  the  temperature  when  tl^  day  becomes 
'hot'  In  this  scenario  the  actual  temperature  is  the  crisp  value  and  the  term  ‘hot’  is  the 
fuzzy  data.  Whereas  almost  nobody  would  say  that  50  degrees  F  is  hot,  and  almost 
everyone  would  say  100  degrees  F  is  hot,  there  remains  a  region  in  between  where 
different  people  would  express  different  opinions.  Therefore,  the  phrase  'it  is  hot' 
represents  a  fuzzy  variable.  The  range  of  values  describes  the  relevant  values  of  the  crisp 
data.  For  temperature,  the  universe  of  acceptable  values  may  range  from  0  to  100 
degrees.  Anything  outside  this  limit  would  not  be  of  concern  and  could  be  considered  to 
be  either  the  high  or  low  limit  for  the  fuzzy  application. 

The  knowledge  base  is  the  programmable,  control  aspect  of  a  fuzzy  logic 
controller.  The  knowledge  base  is  composed  of  If-Then  rules  which  can  be  interpreted  in 
the  fuzzy  logic  process.  Both  the  condition.  If,  and  the  assertion.  Then,  use  crisp 
variables  put  into  a  fuzzy  context  For  example,  temperature  and  humidity  are  crisp 
variables,  but  a  rule  may  be  If  temperature  is  hot  (hot  converts  temperature  into  a  fuzzy 
context),  and  humidity  is  musty.  Then  air  conditioner  power  is  high.  The  database  and 
knowledge  base  combine  to  form  the  information  needed  to  run  a  fiizzy  logic  based 
controller. 

The  first  of  the  five  steps  is  that  of  fuzzification.  This  step  simply  converts  a 
input,  or  a  crisp  value,  into  fuzzy  data.  The  curve  that  defines  the  relationship  between 
the  crisp  data  and  the  fuzzy  variable  is  called  the  member^p  curve. 
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50  deg  100  deg 

Figure  3.1 1  Membership  Curve  Concept 

This  membership  curve  is  used  to  fiizzify  tite  crisp  value  of  degrees  into  the  fuzzy 
variable  hot  With  the  representation  of  hot  =  y(x),  qualifiers  such  as  somewhat  hot  = 
sqrt(y(x))  or  very  hot  =  y(x)^  may  be  used  to  dcetch  related  curves. 

For  any  input  there  may  be  multiple  membership  curves .  Temperature,  for 
example,  may  have  3  curves:  cold,  lukewarm,  and  hot  (Figure  3.12).  These  curves  are 
overl{q)ped  so  that  for  any  temperature  there  wiU  always  be  at  least  a  50%  belief  in  any 
one  curve.  By  overliq)ping  curves,  the  difference  of  opinion  shown  in  the  above 
membership  curve  may  be  used  to  enhance  the  control.  For  a  temperature  of  70  degrees 
the  may  be  a  75%  belief  in  hot  and  a  25%  belief  in  lukewarm  and  a  0%  belief  in  cold. 

Once  the  variables  have  been  fuzzified,  combinational  logic  is  used  to  find  a 
belief  value  in  the  desired  output  Normally  there  are  2  inputs  that  are  being  considered 
for  the  fuzzy  rule.  The  beliefs  for  each  input  ate  then  compared  using  the  fuzzy 
conjunction  of  minimum.  For  example,  for  a  temperature  of  70  degrees  and  a  humidity 
of  75%,  the  belief  in  hot  may  be  50%  and  the  belief  in  humid  may  be  70%.  In  this  case, 
the  output  perhaps  air  conditioner  power,  would  be  medium  to  a  degree  of  50%. 
However,  as  shown  in  Table  3.2,  ibete  ate  mote  possible  combinations  of  relevant 
membemhip  functions  that  must  be  considered.  Once  the  minimum  operator  has  been 
used  to  develop  the  belief  for  each  specific  ouqrut  the  maximum  operator  is  used  to 
combine  the  results  of  any  rules  that  call  for  the  same  action.  This  gives  the  final  fuzzy 
ouqrut  as  Tower  is  Medium  to  a  degree  of  .50  and  Low  to  a  degree  of  .50.' 


eg 


0  d 


50  deg 

Figure  3.12  Multiple  Membership  Curves 
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T^le  3.2  Conjunction  of  Minimum 


Degree 

Humidity 

Degree 

Power 

Degree 

Hot 

0.5 

Musty 

0.7 

Medium 

0.5 

Lukewarm 

0.5 

Average 

0.3 

Low 

0.3 

Hot 

0.5 

Average 

0.3 

Medium 

0.3 

Lukewarm 

0.5 

Musty 

0.7 

Low 

0.5 

The  third  step,  implication,  is  an  intermediate  stage  in  reaching  a  crisp  ouQ>ut 
from  the  fuzzy  data.  Implication  'states  the  way  a  fuzzy  curve  is  implicated  or  deduced 
from  the  belief  value  obtained  in  the  rule  condition.'  [2]  There  are  two  common 
techniques  used  for  this  action:  the  Mamdani  mediod,  which  uses  the  minimum  opendor, 
and  the  Larson  method,  which  uses  Boolean  conjecture.  For  the  purpose  of  this  research, 
the  Mamdani  method  is  used.  This  method  takes  the  minimum  of  the  belief  in  the  If 
condition,  and  the  class  membership  curve  in  the  assertion  [Min(c,y(x))].  [2]  Tire  result 
of  this  is  a  membership  curve  that  has  been  leveled  off  at  the  iq)propriate  belief  value. 

The  fourth  step,  defuzzification,  converts  an  implicated  fuzzy  membership  curve 
into  a  crisp  ouq)ot  As  with  implication,  there  are  several  methods  with  which 
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defuzzification  may  be  accomplished.  The  method  used  in  this  research  is  the  centroid 
method.  The  centroid  method  splits  the  area  under  the  curve  into  two  parts  and  chooses 
the  mean  value  for  the  ou^ut  using 

\x*yix)dx 

*  f  (3.: 

jy(x)dx 

In  Figure  3. 13,  with  area  A  equaling  area  B.  this  would  result  in  a  crisp  output  of  650. 


Since  there  is  more  than  one  fuzzy  ouq)ut  from  the  combinational  logic,  and 
therefore  more  than  one  implicated  membership  curve  and  defiizzifled  ouq)ut,  there  must 
be  a  way  to  convert  these  multiple  ouqiuts  into  a  single  ouq>ut  for  the  controller.  This  is 
accomplished  in  the  fmal  fifth  step,  aggregation.  Aggregation  uses  the  average  of  all  of 
the  crisp  outputs  to  determine  this  one  command.  Continuing  the  temperature  example, 
there  are  two  crisp  outputs,  650  to  a  degree  of  .5,  as  found  by  Figure  3. 13,  and  1000  to  a 
degree  of  .5,  as  found  in  a  similar  manner.  The  final  crisp  output  would  then  be 

.5  *  650 +.5  *1000 


(3.4) 


3.6  Fuzzy  Controller 
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Four  separate  fuzzy  controllers  were  designed  and  evaluated  during  this  research.  The 
first  two  use  S  X  5  control  matrices  while  the  last  two  use  7  x  7  matrices.  All  four  control 
laws  use  2  inputs: 


e 


de 

m 


(3.5) 


to  develop  a  single  torque  output  using  tl^  same  negative  theta  feedback  as  the  PID 
controller. 


Figure  3.14  Fuzzy  Feedback 


3.6.1  Rve  by  Five  Control  Matrix 

The  first  controller  developed  uses  a  5  x  5  control  matrix.  Angle  error,  e  ,  angle  error 
velocity,e,  and  torque  are  all  broken  into  5  divisions:  positive  medium,  positive  ^all, 
zero,  negative  small,  and  negative  medium.  Torque  and  e  share  the  same  membership 
curve  equations  (Table  3.3  and  Figure  3.15)  for  these  divisions,  while  e  uses  different 
curve  equations  (Table  3.4  and  Figure  3.16).  Angle  error  uses  these  different 
membership  curves  to  reduce  steady  state  error.  By  changing  the  zero  membership  curve 
to  become  more  slender,  the  region  where  the  control  law  assumes  that  the  angle  error  is 
zero  becomes  more  confined.  This  is  not  done  for  the  angle  error  velocity  and  torque  in 
order  to  help  the  system  settle.  As  the  angle  error  gets  smaller  it  is  desirable  for  the 
system  to  not  react  as  strongly  as  if  the  angle  error  was  large.  By  increasing  the  range  of 
zero  for  the  error  velocity,  the  system  is  not  as  sensitive  to  small  movements  and  more 
sensitive  to  angle  error.  By  having  a  large  zero  range  for  torque  the  outputs  are  more 
likely  to  settle  as  the  errors  get  smaller.  These  divisions  cover  the  range  between  -.14  and 
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.14  radians  for  e  ,--7  and  .7  radians/second  fco- «  ,  and  -.38  and  .38  volts  fcM'  Unique. 
Although  some  values  of  e  and  e  will  be  outside  of  these  zmies,  the  computer  is  able  use 
these  data  by  assigning  them  to  the  stated  positive  or  negative  extreme.  Since  Unque  is 
the  output  there  will  not  be  any  voltages  outside  of  the  given  range.  The  rules  that  form 
the  matrix  (Table  3.5)  have  equal  weights  and  are  in  the  fcmn  IF  e  IS  NEGATIVE 
MEDIUM  AND  e  IS  NEGATIVE  SMALL.  THEN  TORQUE  IS  NEGATIVE 
MEDIUM. 

Table  3.3  Angle  Error  Velocity  and  Torque  Five  by  Five  Membership  Curve  Equations 
I  Kfembershm  Curve  Equations  I 


POS_MEDIUM 

SIN(Pi*(X-0.5))5 

POS_SMALL 

SIN(Pi*(X-0.25))5 

ZERO 

SIN(Pi*X)3 

NEG_SMALL 

SIN(Pi*(X+0.25))5 

NEG_MEDIUM 

SIN(Pi*(X40.5))5 

Figure  3.15  Membership  Curve  Shapes  for  Angle  Error  Velocity  and  Torque 
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Table  3.4  Angle  Ernw  Hve  by  Five  Membership  Curve  Equations 
Membership  Curve  Equations 


Membership  Curve  Equations 
POS_MEDIUM  SIN(H*(X-0.5))^ 
POS_SMALL  SIN(l.l*Pi*(X-.254))5 
ZERO  SIN(3*Pi*(X^4).33)^ 
NEG_SMALL  SIN(1.1*H*(X-^0.16))^ 
NEG.MEDIUM  SlN(Pi*(X-M).5))^ 


NEG.MEDIUM 


Figure  3.16  Membership  Curve  Shapes  for  Angle  Error 
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Using  symmetry,  the  computer  is  able  to  compensate  for  unfilled  matrix  squares  so  that 
tte  entire  matrix  does  not  need  to  be  filled. 

This  controller  produces  simulations  that  in  general  perform  poorly.  The  torque 
curves  are  not  smooth  and  the  steady  state  error  is  large.  For  a  IS  degree  slew.  .2618 
radians,  the  final  value  is  .2130  radians,  or  a  18.4%  steady  state  error.  The  system  does 
not  get  to  within  5%  of  the  desired  stetuly  state  value,  but  the  steady  state  settling  time  is 
1 1  seconds.  The  one  good  performance  result  is  a  O.S  second  rise  time.  Unfortunately 
because  of  an  inirial  di^lacement  in  the  wrong  direction  this  does  not  occur  until  2.58 
seconds  into  tl^  simulation.  Also,  this  rise  time  results  in  a  78%  overshoot 

Fortunately  this  is  not  the  end  of  the  fuzzy  control  story.  Although  this  5x5 
control  law  works  poorly  in  simulation,  there  are  two  redeeming  features.  The  first 
which  will  be  shown  later  in  die  paper,  is  that  as  the  control  law  matrix  expands,  the 
system  performance  improves.  The  second  is  that  in  hardware  the  torque  gets  filtered 
somewhat  by  the  dynamics  of  the  motor  and  the  electronic  amplifier.  This  in  turn  takes 
some  of  the  shake  out  of  the  theta  le^nse.  Also,  because  fuzzy  logic  controllers  are  an 
iterative  process,  a  change  in  the  torque  response  early  in  the  slew  greatly  effects  the  rest 
of  the  slew.  The  effects  of  this  filtering  ate  seen  in  the  theta  and  torque  re^nses  from  a 
test  on  the  actual  hardware. 
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Figure  3.18  Five  by  Rve  Torque  Simulation,  15  Degree  Slew 


For  a  15  degree  slew  on  the  hardware  (Figure  3.19  and  Figure  3.20),  the 
steady  state  value  is  .27  radians.  This  is  only  a  3. 1%  steady  state  error.  The  system  is  a 
little  slower  with  a  14  second  settling  time  and  a  1.142  second  rise  time.  With  die  slower 
response,  the  overshoot  also  decreases  to  52%. 

Although  the  performance  values  differ  between  the  simulation  and  hardware 
results,  correlation  is  maintained  in  the  same  basic  shtqie  and  response.  The  hardware 
response  does  not  begin  in  the  opposite  direction  as  the  simulation  does,  but  it  does 
resemble  the  simulation  response  for  the  first  few  seconds.  Both  results  also  have  3 
peaks  reached  at  approximately  the  same  times.  The  flrst  peak  is  at  about  4.5  seconds, 
the  second  peak  is  at  about  7  seconds,  and  the  third  peak  is  at  about  10  seconds. 


3.6.2  Two  Five  by  Five  Control  Matrices 

When  designing  a  fiizzy  logic  controller  for  a  manipulator  there  are  three  techniques  that 
may  be  applied:  set  the  universal  values  for  the  largest  possible  case,  set  the  universal 
values  small  to  give  good  resolution  and  reduced  steady  state  oscillations,  and  set  the 
universal  values  using  a  combination  of  the  first  two.  In  the  single  5x5  control  matrix 
used  above,  a  combination  of  the  first  two  designs  was  used  with  an  emphasis  on 
reducing  steady  state  oscillation.  It  was  hypothesized,  however,  that  by  using  two  control 
laws  within  the  same  controller  the  best  parts  of  each  control  technique  could  be 
exploited  without  compromising  either  advantage. 

If  the  first  control  law  is  tuned  to  recognize  large  errors  and  is  given  a  larger  range 
of  possible  torque  outputs,  the  initial  time  response  can  be  reduced.  If  this  controller  is 
kept  active,  however,  the  controller  may  not  be  able  to  distinguish  a  zero  error  from  a 
small  error.  This  lack  of  resolution  may  cause  the  controller  to  command  a  torque 
response  that  is  too  large  for  the  actual  situation.  This  exaggerated  torque  often  ends  in 
the  arm  slewing  past  the  desired  point  The  controller  then  'catches’  the  arm,  but  again 
slews  it  past  the  desired  point  This  continues  to  happen  resulting  in  a  steady  state 
oscillation  instead  of  a  settled  steady  state  value.  To  combat  the  oscillation  problem,  the 
controller  must  have  a  tighter  range  of  error  and  torque.  The  single  5x5  controller  does 
this,  but  the  initial  time  response  is  slow  with  the  2  second  lag.  Combining  these  two 
designs  solves  both  problems. 

The  design  of  this  structure  gives  control  to  the  large  control  law  for  two  seconds. 
After  the  initial  slew  has  occurred,  control  passes  to  the  small  controller  in  order  to  damp 
out  the  system.  The  large  matrix  covers  the  ranges  between  +/-  0.5  radians  for  angle 
error,  +/- 1.5  radians/second  for  angle  error  velocity,  and  +/-  0.6  volts  for  torque.  The 
membership  curve  equations  for  angle  error  are  shown  in  Table  3.4,  and  the  control 
matrix  in  Table  3.5.  The  membership  curve  equations  for  angle  error  velocity  and  torque 
are  the  same  as  for  the  single  5x5  matrix.  The  small  matrix  is  exactly  the  same  as  for  the 
single  5x5  matrix. 

This  method  works  in  speeding  up  the  initial  time  response  and  does  damp  out  the 
system,  but  there  are  trade-offs  in  how  the  system  is  set  up.  If  the  hand-off  between  the 
large  and  small  controller  is  done  at  the  wrong  time,  or  the  system  switches  back  and 
forth  between  the  two  controllers  through  out  the  slew,  the  system  response  may  not  be 
smooth.  This  action  causes  the  overall  settling  time  to  increase  rather  than  decrease.  In 
this  system,  if  the  large  controller  is  left  active  over  2  seconds  the  hand-off  to  the  small 
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Table  3.6 


Membership  Curve  Equations 

POS_MEDIUM 

SIN(Pi*(X-0.5))5 

POS_SMALL 

SIN(Pi*(X-0.22))5 

ZERO 

SIN(2*Pi*(X+4.75))5 

NEG.SMALL 

SIN(Pi*(X+0.25))5 

NEG.MEDIUM 

SIN(Pi*(X+0.5))5 

Table  3.7  Large  Five  by  Five  Controller 

Rule  Matrix 

NM 

NS 

ZR 

PS 

PM 

NM 

NM 

NM 

PS 

NS 

NS 

NS 

PM 

ZR 

NM 

ZR 

PM 

PS 

NM 

PS 

NS 

PM 

NS 

PM 

PM 

controller  is  not  smooth.  The  large  controller  is  used  to  begin  the  initial  slew,  but  if  it  is 
aUowed  to  continue,  the  response  of  the  system  may  require  a  large  voltage.  If  the  small 
controller  is  made  active  at  this  point,  the  manipulator  wiU  not  respond  as  desired.  Also, 
if  the  controllers  are  switched  back  and  forth,  the  discontinuities  in  the  voltage  outputs 
may  increase  the  oscillations  of  the  system.  The  results  of  the  hardware  tests  of  this 
system  are  shown  in  Figure  3.21  and  Figure  3.22  The  time  response  of  this  controller  is 
better  than  the  single  SxS  matrix.  The  system’s  settling  time  decreases  from  14  seconds 
to  13  seconds  while  the  steady  state  error  only  increases  from  3.1%  to  3.7%.  Due  to  the 
increased  voltage  input  for  the  initial  slew,  the  overshoot  using  this  system  rose  from 
52%  to  62%.  Surprisingly,  however,  the  rise  time  remained  constant  at  1.14  seconds. 
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3.6.3  Robustness 

To  examine  the  performance  robustness  of  the  fuzzy  logic  controller,  three  off-design 
tests  were  accomplished.  The  first  ofif-design  test  added  a  1,160  gram  mass  to  die  end  of 
the  on-design  manipulator,  the  second  tulded  a  830  gram  mass  to  the  end  of  the 
manipulator,  and  the  third  off-design  te^  used  a  1/16  inch  aluminum  arm  instead  of  the 
on-design  1/8  inch  aluminum  arm.  Both  the  PID  controller  and  the  two  control  law  fuzzy 
logic  controller  were  tested  in  both  of  tte  situations  for  a  command  slew  of  IS  degrees. 

Figure  3.23  shows  the  theta  response  for  the  fuzzy  logic  controller  to  the  first 
robustness  test.  As  a  matter  of  practicality  in  data  acquisition,  only  the  first  30  seconds  of 
the  test  slews  were  recorded.  However,  it  is  obvious  in  this  time  that  although  the 
controller  does  not  settle  the  system  within  the  first  30  seconds,  the  system  is  indeed 
damped.  Figure  3.25  shows  the  theta  response  for  the  PID  controller  for  the  same  test 
By  noticing  that  the  second  overshoot  is  larger  than  the  first  it  is  apparent  that  unlike  the 
fuzzy  logic  controller,  the  PID  controller  is  not  stable  for  this  off-design  condition. 


Figure  3.23  Theta  Response  for  Fuzzy  Logic  Robustness  Test  1, 15  Degree  Slew 
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The  theta  response  of  the  fuzzy  logic  controller  for  the  second  test  is  shown  in 
Figure  3.27.  Again  the  response  is  only  shown  for  30  seconds,  but  it  is  apparent  that  the 
system  is  stable.  It  is  also  apparent  from  the  last  undershoot  that  the  system  is  settling 
into  approximately  15  degrees.  The  theta  re^nse  for  the  PID  controller  (Figure  3.29), 
shows  that  for  this  off-design  case,  the  PID  control  law  is  able  to  stabilize  the  system. 
The  PID  controller  appears  to  be  taking  longer  to  settle  the  system  than  the  fuzzy  logic 
controller,  but  overall  the  two  controllers  seem  comparable  for  this  off-design  condition. 


Figure  3.29  Theta  Response  for  PID  Robustness  Test  n.  15  Degree  Slew 


The  fuzzy  logic  control  law  results  for  the  third  robustness  test  are  shown  in 
Figures  3.27  and  3.28.  Figure  3.27  shows  the  theta  results  for  the  fuzzy  logic  controller. 
For  this  off-design  case  the  controller  stimulates  the  natural  frequencies  of  the  arm  and 
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the  overall  performance  is  lower  than  the  on-design  condition,  but  the  flexible  arm  damps 
out  relatively  quickly.  The  system  settles  to  within  5%  of  the  final  value  in  10  seconds, 
which  is  better  than  the  on-design  case,  but  the  final  value  of  .2415  radians  is  7.75% 
lower  than  the  desired  value  of  .2618  radians.  Like  the  steady  state  error,  the  rise  time 
and  percent  overshoot  of  the  system  both  iiK:ieased  versus  the  on-design  case.  The  rise 
time  increased  almost  0.6  seconds  to  1.72  seccmds  and  the  percent  overshoot  increased 
from  62  percent  to  77  percent 

Figures  3.29  and  3.30  show  the  PID  controller  results  for  the  third  robustness  test 
For  this  configuration  the  PID  controller  works  well  overall  with  the  exception  that  the 
flexible  arm  never  actually  damps  out  completely.  The  manipulator  settles  to  within  5 
percent  of  the  reference  value  in  8  seconds,  which  is  only  0.5  seconds  slower  than  the  cm- 
design  condition,  but  the  steady  state  response  has  a  47- 1.0  percent  steady  state  error 
compared  to  a  2.7  percent  constant  error  for  the  on-design  case.  Although  the  re^nse  is 
actually  more  accurate,  the  steady  state  (^dilation  shows  the  one  weakness  of  the  PID 
controller  in  this  test  The  rise  time  of  this  system  is  0.85  seconds  faster  than  die  original 
value,  but  the  overshoot  increases  from  5.71  percent  to  15  percent 


Figure  3.31  Theta  Response  for  Fuz^  Logic  Robustness  Test  HI,  15  Degree  Slew 


Figure  3.34  Torque  Response  for  PID  Robustness  Test  m,  IS  Degree  Slew 


3.6.4  Seven  by  Seven  Control  Matrices 

As  described  for  the  5x5  matrices,  one  method  to  reduce  steady  state  error  was  to  make 
the  membership  curves  around  zero  smaller  to  give  better  resolution  for  a  true  zero  error. 
It  follows  that  if  many  small  membership  curves  are  used  instead  of  a  few  large 
membership  curves,  the  resolution  for  the  entire  universe  of  values  will  improve.  If  this 
approach  is  used  for  not  only  angle  error,  but  also  angle  error  velocity  and  tcnque  the  time 
response  of  the  system  will  improve  instead  of  just  the  steady  state  error,  hi  this  section 
the  results  of  a  control  law  using  a  single  7x7  control  matrix  and  a  control  law  using  two 
7x7  control  matrices  will  be  discussed.  Unfortunately,  due  to  computer  software 
problems  in  downloading  these  control  laws  to  the  real-time  control  computer,  only 
computer  simulations  of  these  control  laws  were  possible. 

The  7x7  matrices  use  the  same  five  divisions  used  in  the  5x5  matrices  plus 
positive  large  and  negative  large.  For  the  single  7x7  controller,  the  seven  divisions  are 
spread  from  +/-  0.5  radians  for  angle  error,  +/-  2  radians/second  for  angle  error  velocity, 
and  +/-  0.3  volts  for  torque.  Because  of  the  adcfed  number  of  membership  curves,  all  of 
the  membership  curves  have  the  same  sh^  for  all  three  variables.  The  equations  for  the 
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curves  for  this  controller  are  shown  in  Table  3.8  while  the  rule  matrix  is  shown  in  Table 
3.9. 

Table  3.8  Single  Seven  by  Seven  Controller  Membership  Curves 


Membership  Curve  Equations 

POS_LARGE 

SIN(Pi*(X-0.5))9 

POS.MEDIUM 

SIN(Pi*(X-0.5))5 

POS_SMALL 

SIN(Pi*(X-0.25))5 

ZERO 

SIN(Pi*X)3 

NEG_SMALL 

SIN(Pi*(X+0.25))5 

NEG_MEDIUM 

SIN(Pi*(X+0.5))5 

NEG_LARGE 

SIN(Pi*(X+0.5))9 

The  simulation  results  for  the  single  7x7  controller  are  shown  in  Figure  3.29  and 
Figure  3.30.  In  general,  when  comparing  die  results  of  the  hardware  tests  using  the  single 
5x5  controller  to  the  results  of  the  simulation  tests  using  the  single  7x7  controller,  the 
performance  values  improve  for  the  larger  matrix.  Although  the  steady  state  error 
increased  from  3.1  percent  to  3.7  percent,  a  difference  of  only  0.1  degrees,  the  rise  time 
decreased  by  3.5  seconds  to  10.5  seconds  and  the  percent  overshoot  decreased  from  52 
percent  to  only  40  percent  The  rise  time  actually  rose  0.18  seconds,  but  due  to  the  initial 
2  second  lag  for  the  5x5  controller  response,  the  system  reached  90  percent  of  the  steady 
state  value  faster  overall  with  the  7x7  system. 
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large  controller  are  the  same  as  the  single  7x7  controller  with  the  exception  that  the 
universal  range  for  the  angle  error  is  4/- O.S  radians  instead  of  W- 0.3  radians.  The  small 
controller  uses  the  same  membership  curves,  but  the  rule  matrix  and  universal  values  are 
changed.  The  universal  values  of  angle  error  range  from  -tV-  0. 17  radians,  the  values  of 
angle  error  velocity  range  from  +/-  0.4S  r^lians/second,  and  the  values  of  U»que  range 
from  +/-  0. 1  volts.  The  rule  matrix  for  the  small  controller  is  shown  in  Table  3. 10. 


Table  3.10  Small  Seven  by  Seven  Controller  Rule  Matrix 


NL 

NM 

NS 

ZR 

PS 

PM 

PL 

NL 

NM 

NM 

NS 

PM 

NS 

NS 

NM 

PM 

ZR 

NM 

NM 

ZR 

PM 

PM 

PS 

NM 

PM 

PS 

PM 

NM 

PS 

PL 

PM 

The  results  of  the  double  7x7  control  law  are  the  best  of  any  of  the  examined 
controllers.  The  theta  and  torque  responses  of  the  system  (Figures  3.31  and  3.32)  show 
the  performance  values  of  this  controller.  The  steady  state  error  is  only  2.6  percent,  the 
rise  time  is  only  1  second,  and  the  settling  time  is  only  7  seconds.  While  these  are  the 
fastest  responses  of  any  of  the  controllers,  there  is  still  only  a  42  percent  overshoot 
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Figure  3.37  Double  Seven  by  Seven  Theta  in  Simulation,  15  Degree  Slew 

0.3 

0.2 

0.1 

0 

-0.1 

-0.2 

0  5  10  15  20 

time 

Figure  3.38  Double  Seven  by  Seven  Torque  in  Simulation,  15  Degree  Slew 
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Chapter  4:  Conclusioas  and  Recommendations 


4. 1  Conclusions 

The  purpose  of  this  work  was  to  explore  different  fuzzy  logic  controller  configurations 
and  implement  them  on  a  single  link,  flexible  robot  arm.  The  first  step  in  this  process 
was  to  validate  the  plant  model  and  the  AC100-C30  system  by  implementing  a  PID 
controller  in  simulation  as  well  as  hardware.  When  this  was  accompli^ed,  four  fuzzy 
logic  controllers  were  designed.  The  performance  values  of  all  of  the  tested  controllers 
are  shown  in  Table  4. 1 . 

The  first  controller  used  a  single  SxS  rule  matrix  while  the  second  controller  used 
two  SxS  rule  matrices.  Using  the  two  rule  matrices  in  the  second  controller  allowed  die 
system  to  respond  faster  to  the  initial  slew  command  than  the  single  rule  matrix  controller 
while  still  settling  to  a  fmal  value.  To  help  reduce  steady  state  error  while  using  the  SxS 
rule  matrices,  the  membership  curves  corresponding  to  zero  error  were  reduced  in  width 
in  comparison  to  the  rest  of  the  membership  curves. 

The  third  and  fourth  controllers  used  7x7  rule  matrices.  Due  to  the  increased 
granularity  added  by  the  smaller  membership  curves  associated  with  the  larger  matrices, 
the  shapes  of  the  individual  membership  curves  could  remain  constant  while  still 
achieving  good  steady  state  error  performance.  As  with  the  5x5  rule  matrix  controllers, 
the  Hrst  7x7  controller  used  a  single  rule  matrix  while  the  second  control  law  used  two 
7x7  controllers.  Unfortunately,  due  to  a  software  error  between  simulation  and  hardware- 
in-the-loop  implementation,  the  7x7  controllers  could  not  be  implemented  in  hardware. 
The  performance  values  of  these  two  controllers  in  simulation,  however,  showed  the 
advantage  of  a  larger  control  mauix. 

The  robustness  of  the  PID  controller  as  weD  as  the  double  5x5  control  law  fuzzy 
logic  controller  were  examined  in  three  tests.  The  first  test  was  a  15  degree  slew  with  a 
1 160  gram  mass  at  the  tip  of  the  manipulator.  The  second  test  was  a  15  degree  slew  with 
a  830  gram  mass  at  the  tip  of  the  manipulator.  The  third  test  was  a  15  degree  slew  with  a 
l/16th  inch  thick  manipulator  instead  of  the  on-design  l/8th  inch  thick  manipulator.  The 
results  of  these  tests,  listed  in  Table  4,1,  show  that  the  5x5  rule  matrix  fuzzy  logic 
controller  is  indeed  stable  for  all  of  these  conditions  while  the  PID  controller  actually 
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goes  unstable  in  the  first  test  Although  the  fuzzy  logic  controller  does  not  settle  the 
manipulator  within  30  seconds  in  two  of  these  tests,  and  has  a  7  percent  steady  state  error 
in  the  third,  it  must  be  remembered  that  the  simulation  results  show  the  performance  of 
the  7x7  rule  matrix  control  laws  superior  to  the  5x5  rule  matrix.  It  is  probable  that  if 
these  control  laws  were  implemented  in  tte  hardware  that  they  would  perform  better  than 
the  5x5  control  laws.  Overall,  however,  the  fuzzy  logic  controllers  were  able  to  show  the 
robust  characteristics  inherent  to  the  control  law. 


Table  4.1  Performance  Response 


Steady  State 

Error 

Rise  Time 

(Seconds) 

Overshoot 

Settling  Hme 
(Seconds) 

PID 

2.7% 

2.81 

5.71% 

7.5 

5x5 

3.1% 

1.142 

52% 

14 

2x5x5 

3.7% 

1.14 

62% 

13 

7x7 

3.7% 

1.32 

40% 

10.5 

2x7x7 

2.6% 

1 

42% 

7 

Robust  I 

PID  Unstable 

Fuzzy  Logic  Stable 

Robust  n 

Both  Stable 

PID  Robust  in 

1% 

1.96 

15% 

8 

Fuzzy  Robust 

in 

7.75% 

1.72 

77% 

10 

4.2  Recommendations 

There  are  a  couple  different  directions  for  future  work  for  fuzzy  logic  and  the  flexible 
manipulator.  The  tirst  possibility  would  be  to  continue  working  on  the  single  link  arm. 
Although  this  research  explored  the  basic  concepts  of  fuzzy  logic  and  demonstrated  the 
general  performance  and  robustness  of  fuzzy  logic,  it  did  not  explore  the  complexities  of 
fuzzy  logic.  Some  areas  that  could  be  used  in  the  future  are  adding  weights  to  the  rules 
and  using  qualifiers  for  membership  curves.  By  using  these  aspects  of  fuzzy  logic,  the 
5x5  rule  matrix  controllers  may  be  improved  in  both  on-design  and  off-design 
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performance.  Along  with  adding  these  areas  in  the  control  law,  further  work  should  be 
done  with  Integrated  Systems  Inc.  to  allow  7x7  fuzzy  logic  rule  matrices  to  be  used  with 
the  hardwate-in-the-loop  capabilities  of  the  AC100-C30  system.  If  ISI  is  not  able  to 
debug  their  C  code  generator  it  may  still  be  profitable  for  C  code  to  be  hand  written  to 
accommodate  the  7x7  controller. 

A  second  direction  for  future  work  is  the  addition  of  a  second  link  to  the 
manipulator.  At  this  time,  a  PID  controller  is  operational  in  the  University  of 
Washington  Control  System  Laboratory  robot  arm  test  facility  for  a  two  link  flexible  arm. 
The  next  step  could  be  to  implement  a  fuzzy  logic  controller  on  this  hardware  and 
compare  the  performance  capabilities  of  the  controllers. 

Finally,  a  third  direction  for  future  work  concerns  the  sensors  in  the  hardware.  If 
the  manipulator  is  to  be  slewed  and  damped  as  quickly  as  possible,  real-time  knowledge 
of  the  manipulators  dynamics  would  be  helpful.  For  this  research,  only  the  base  angle, 
theta,  was  known.  If,  as  in  the  work  at  the  University  of  Akron  [4],  tip  displacement  was 
known  as  well  as  base  angle,  the  controller  could  actively  damp  some  of  the  flexible 
modes  as  well  as  slew  the  manipulator  to  the  desired  angle. 
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Appendix  A:  Plant  Generation  Programs 


I.  Parameters 

//  Description:  Returns  SLA  inertial  and  geometric  parameters  for  system 
//  configuration  A.  This  configuration  is  a  long  single  flexible 

//  link  with  no  tip  mass  loading. 

// 

// 

//  Input  Variables 

//  n  =  number  of  flexible  elements  for  link 
// 

//  Output  Variables 

//  Dll  =  Inertia  of  shoulder  hub  about  its  mass  center 

//  Ih2  =  Inertia  of  tip  hub  about  its  mass  center 

//  Di  =  Inertia  of  ith  link  about  its  mass  center 

//  Itl  =  Inertia  of  tip  (bracket  and  mass)  about  its  mass  center 

//  mhl  =  mass  of  shoulder  hub 

//  mh2  =  mass  of  tip  hub 

H  mb  =  mass  of  ith  link 

//  mtl  =  mass  of  tip  (bracket  and  pad) 

//  chi  =  distance  from  shoulder  diafr  to  shoulder  hub  center  of  mass 

//  ctl  =  distance  from  tip  hub  centroid  to  tip  center  of  mass 

//  ohl  =  distance  from  shoulder  diaft  to  shoulder  hub  attatch  point  of  link  1 

//  otl  =  distance  from  tip  hub  centroid  to  tip  attatch  point 

//  U  =  length  of  each  rigid  segment  of  link  i 

//  ki  s:  torsional  spring  stiffness  between  ith  link  segments 

//  bi  =  torsional  viscous  damping  between  ith  link  segments 

//  Revision:  20JULY93 
//  by  Steve  Evers 
nl=20 

th  l_nom=45  *pi/l  80 

//  shoulder  hub  parameters 
Dll  =  4.1238e-03;  //kg*m**2 
mhl  =  1.1618; //kg 
chi  =  5.5959e-05;  //m 
ohl=5.8420e-02;//m 

//  link  1  parameters 

//  long  flexible  link,  no  mass  intensifiers 
mil  =  415.5/1000;  //kg  (measured) 
mil  =  mll/nl; //kg 

11  =  ((40.5-l-1.5)/12)*0.3048;  //m  (measured) 

11  =ll/nl;//m 

ni  =  (mll*ll**2)/12;  //kg**2 
//  tip  1  parameters 

//  tip  is  composed  of  bracket,  pad,  and  link  grip  length 
//  tip  location  is  defined  as  centerline  of  bracket  base  bolts 
mtl  =  2.9842e-01;  //kg 
ctl  =4.3807e  04;//m 
otl  =  6.3500e-03;  //m 


ctl  =4.3807e-04;//m 
otl  =  6.3500e-03;  Urn 
Itl  =  1.1045e-03;  //kg*m**2 

//  no  motor  hub2  loaded 

//  all  end  point  loading  is  assiciated  with  tip  parameters 
Ih2  =  0; 
mh2  s  0; 

//  beam  lateral  stifiiess  properties 
//  AL  6061  stiffness 
E  =70e9;//N/m**2  =  Pa 
h  =  (1.5/12)*0.305;//m 
b  =  ((l/8)/12)*0.305;//m 
l  =  h*b**3/12;//m**4 
EDI  =7.9; 

kl  =  3*Eni*(nl*(nl-l)*(2*nl-lV6y(nl»*2*nl*ll); 

//  beam  structural  damping 

//  tuned  to  40th  order  plant  model  Stanford  experimental  results 

b  =  0.01; 

bl=300*h/nl; 


n.  Plant  Generator 


//  Description:  Synthesizes  a  lumped  spring/mass/damper  (LSMD)  state  space 
//  model  for  the  UW  flex-flex  SLA  in  the  following  form: 

// 

//  d/dt{x}=A{x)-fB{u} 

//  {del_y)=C{x}  +  D{u} 

// 

//  Note:  both  (x)  and  {del_y)  are  referenced  to  the  LCX^AL 

//  coordinate  system  determinedd  by  the  state  vecter 

//  x=  (0... Othl  nomO... 0}‘ 

II 

//  X  =  {dthl  dqll ...  dql(nl-l)  thl ...  ql(nl-l)}* 

II  {del_y)  =  {x  deLxep  del_yep}' 
n  {u}  =  {Tl}* 

//  T1  =  shoulder  torque 
//  thl  =  shoulder  joint  base  angle 
//  del.xep  =  X  end  point  pertu^d  dyruunics 
//  del_yep  =  y  end  point  perturbed  dynamics 
//  ALL  UNITS  IN  METRIC 
// 

//  Input  Variables:  nl  =  number  of  flexible  elements  for  first  link 
//  thl  nom  =  nomirud  shoulder  joint  angle  to  linearize  about 

// 

//  Output  Variables:  [A3.C4)]  s  state  space  realization  in  locally  prescribed 
//  coordiriate  system. 

H  Revision:  28JUNE93 
//  by  Steve  Evers 

//  load  inertia/spring/mass  parameters 
SLA_plant_paiam_f 

//  mass  matricies 
fori  =  2:nl-l,... 

M.inertiasl  l(i,i)  =  HI;... 
end 

M.inertiasl  1(1,1)  =  Dil+ni; 

M.inertiasl  l(nl,nl)  =  Ill+Itl+Ih2; 

M.inertias  =  [M.inertiasll]; 

fori=s2:nl-l,... 

M_hubs_diagl  1(U)  =  mh2*ll**2;... 
end 

M_hubs_diagl  1(1,1)  =  rahl*chl**2+mh2*(ohl+ll)**2; 

M_hubs_diagl  l(nl4il)  =  mh2*(ll-K)tl)**2; 

M_hubs_diag  =  [M_hubs_diagll]; 

fori  =  2:nl,... 

M_linkl_diagll(M)  =  (l/4)*mll*ll**2+(nl-i)*mll*ll**2;... 
end 

//  Stanford  element  I  believe  to  be  incorrect 


//M^linkl^diagl  1(1.1)  =  fnll*(ohl-Kll/2))**2+nl*mll*(ohl+ll)**2; 

//  My  element 

M_liiikl_diagl  1(1,1)  =  mll*(ohl+(ll/2))**2+(nl-l)*mll*(ohl+ll)**2; 
M_linkl_diag  =  [M_linkl_diagll]; 

M_tipl_diag  =  O*ones(nl); 
fori  =  2:nl-l,... 

M_tipLdiag(U)  =  mtl*ll**2;... 
end 

M_tipl_diag(l,l)  =  mtl*(ohl+ll)**2; 

M_tipl_diag(nl4il)  =*  mtl*(ll+otl+ctl)**2; 

M_hubs_off_diagll  =  0*ones(nl4il); 
for  i  =  2:nl-2,... 
forj  =  i+l:nl-l,... 

M_hubs_ofLdiagll(iJ)  =  mh2*ll**2;... 
end 
end 

fori  =  2:nl-l,... 

M_hubs_off_diagll(U)  =  mh2*(ohl+ll)*ll;.., 

M_hubs_off_diagll(i4il)  =  mh2*ll*(ll-H)tl);... 
end 

M_hubs_off_diagl  l(l.nl)  =  mh2*(ohl+ll)*(ll-M)tl); 

M_hubs_off_diagll  =  M_hubs_off_diagll+M_hubs_off_diagir; 
M_hubs_off_diag  =  [M_hubs_off_diagll]; 

M_linkl_off_diagll  s  0*ones(nl4il); 
fori  =  2:nl-l,... 
forjsi+lrnl,... 

M_linkl_off_diagll(i,j)  =  (l/2)*mll*ll**2+(nl-j)*mll*ll**2;... 
end 
end 

for  i  =  2:nl,... 

M_linkl_off_diagll(l,i)  =  (l/2)*mll*(ohl+ll)*ll+(nl-i)*mll*(ohl+ll)*ll 
end 

M_linkl_off_diagll  =M_linkl_off_diagll+M  linkl_off  diaglT; 
M_linkl_off_diag  =  [M_linkl_ofr_diag  11];“ 

M_tipl_off_diagll  =  0*ones(nl,nl); 
for  i  =  2:nl-2,... 
forj  =  i+l:nl-l,... 

M_tipl_off_diagll(i,j)  =  mtl*ll**2;... 
end 
end 

fori  =  2:nl-l,.., 

M_tipl_off_diagll(l,i)  =  mtl*(ohl+ll)*ll;... 

M_tipl_off_diagll(i,nl)  =  mtl*ll*ai+otl4ctl);... 
end 

M_tipl_off_diagll(l,nl)  =  mtl*(ohl+ll)*(ll+otl-fctl); 

M_tipl_off_diagl  1  =  M_tipl_off_diagl  l-»-M_tipl_off_^agir; 
M_tipl_off_diag  =  [M_tipl_off_diagll]; 
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M  = 

M_ineitias+M_httbs_diag+M_linkl_diag+M_tipl_diag-»-M_hubs_off_(iiag+M_linkl_off 
_(liag+M_iip  l_off_diag; 

//  state  transformation  of  mass  matrix 
for  is  l:nl.... 
forj  s  l:nl,... 

Mbar(y)  =  sum(M(iJ:nl));... 
end 
end 

//nargin=3 
//if  nargin  >=  5,... 

//  klskl*kf;... 

//end 

//  stiffness  matrix 
for  is  l:(nl-l)„.. 

KKl(U+l)  =  -kl;... 

KKl(i+U+l)  =  kl;... 
end 

K  =  [KK1  ]; 

//  damping  matrix 
for  is  l:(nl-l),... 

Dl(U+l)s.bl;.,. 

Dl(i+U+l)  =  bl;... 
end 

Ds[D1]; 

//  input  torque  matrix 
T  =  0*oiies(nl,l); 

T(l.l)=l; 

//  state  space  realization 
//  Mbar{d/dt(x) I  s  a{x}  +  T{u} 

//{y}=C{x}  +  D{u} 

Mbar  =  [Mbar  0*ones(nl); 

0*ones(nl)  eye(nl)]; 

As[-1*D-1*K; 

eye(nl)  0*ones(nl)]; 

T  =  rr;0*ones(nl,l)]; 

Abar  s  Mbai\A; 

Bbar  =  Mbai\T; 

C  s  [eye(2*nl); 

0*ones(2^*nl)]; 

//  Stanford  model  had  error  in  the  term  relating  to  the  1st  element  of  each  link 
//  del_x  component 

C(2*nl+l,nl+l)  =  -(ohl+ll)*sin(thl_nomHnl-l)*ll’'‘sin(thl_nom)-otl*sin(thl_nom); 
cc  =  -(nl-l)*ll*sin(thl_nom)-otl'*sin(thl_nom); 
for  is  l:(nl-l),... 

C(2*nl+l,nl+i+l)  s  cc-(l-i)*ll*sin(thl_nom);.,. 
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end 

//  deLy  component 

C(2*nl+2jii+l)  =  (ohl+ll)*cos(thl_nom)+(nl-l)*ll*cos(thl_nom)+otl*cos(thl_nom); 
cc  =  (nl-l)*ll*cos(thl_nom>K)tl*cos(thl_nom);  ”  ~ 

fori=  l:(nl-l),... 

C(2*nl+2^1+i+l)  =  cc-Kl-i)*ll*cos(thl_nom);... 
end 

D  =  0*ones(2*nl+2.1); 


Appendix  B:  TLA  Model  Development 


This  section,  taken  directly  from  the  work  by  Evers,  summarizes  the  steps  taken  in 
developing  a  6  DOF  dynamic  model  for  the  TLA  manipulator.  The  SLA  is  then  derived 
from  this  ^velopment  The  model  parameters  used  are  those  described  in  Figures  2.1 
and  2.2.  Three  elements  per  link  are  used  to  develop  the  6  DOF  model. 

Lag^ges  approach  will  be  used  in  this  derivation  of  system  dynamic  equation  of 
motion.  Using  the  model  structure  of  Figure  2.2,  with  3  (equal  length  and  mass)  elements 
per  link,  the  mass  center  velocities  of  each  element  are  as  follows. 

2  2  2 
vl  =(Ou+j)^Ui^ 

+  /l)/lCOS(-^„) 

=  UiHOu  +  /!)*  +  «2*n*  + 

+2«,«2{o*,  +  /l)/lcos(-4n)+«i«3(OM  +W)«C08(-9n -q^) 

Vrt  =  «,*(<?*, +11)^ +M2*n* +V{n+ On  +c,tf  + 

+2u,M2(o*i  +/l)/lcos(-^i,)+2«i«j(Ou  +/1X/1+0,1  +  c,i)cos(-^ii  -4,3) 

+2«2«3/1(/1  +  0„  +Crt)COS(-ft2) 

V*2  =  +  Oaf  + 

+2«ill2(0„  +/1X1C08(-^ii)  +  2|Ii«3(0m  +nKft+Ort)cos(-g,i  -912) 

+2UiU4(Om  +/1)C»2  COS(-flj,  -*2  -®2)  +  2«2«3n(/l  +  0,i)C0S(-^,2) 

+2H2«4/1c*2  C0S(9,2  -  02  )  +  2ll3«4(/l  +  0,1  )C*2  COS(-02  ) 

v/^  =  UiHOu  +fl)^  +«2’n^  +«52(n  +  0,i)%«4*(0*2  +  y)* 

+2«i«2(0w  +  /l)acos(-^ii)+2Mi«3(OM  -mKfl+o,i)cos(-g„  -^12) 

12 

+2«iH4(Oai  +/1)(0*2  +  y)C0S(-9u -Qn  -02)  +  2ll2«3/l(/l  +  O,j)COS(-9,2) 

12  /2 
+2«2U4a(0*2  +y)COS(-gi2  -02)+2H3«4(n  +  0, 1X0*2  +2')C0S(-®2) 

v?„  =  Mi^(0*i  +n)*  +«2^11^  +11,2(11  +  0,,)^  +II4* (0*2  +/2)* 

+2«i»2(o*i  +/!)/!  ct»(-^,i)+2«i«j(o*i  +nxn+o,i)cos(-qji-qj2) 

+2«, 114(0*,  +  aXo*2  +  /2)cos(-?ii  -  9i2  -  ^2) 

+(<1(15(0*1  +a)/2cOS(— ^11  —  ^12  —02  ~02l) 

+2«2(<3/1(/1  +  0,1 )  COS(-4i2  )  +  2«2«4a(0*2  + 12)  COS(-^  12  -  02  ) 

+«2((5a/2cOS(-9,2  -02  -?2l)  +  2«3«4(a  +  0„XO*2  +/2)COS(-02) 

+«3«5(a  +  O,i)/2cOS(-02  -^2i)+«4«5(<>M  + /2)/2 C0S(-^21  ) 
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+/!)*  +iij^(/l+Oaf  +ii4*(o*2  +^2)^  +Ks^^2^  +  «6^(Y)^ 

+2uiU2(Oki  +n)ncos(-^i)+2uiUi(ou  +nXll+o,i)coe(-gii  -ftj) 

+2U1U4COU  +nXOia  +C)C08(-fl,i -4t2  -«2)  +  2ii,«5(o„  +/l)/2C0S(-fl,i  -«i2 
+Il,ll4(0„  +/l)acos(-(}„  -«,2  -q22)+2u2Uin(ll  +  o,i)cos(-qi2) 

+21I2M4/KOU  +/2)C08(-ft2  -®2)  +  2u2*5^U2C08(-ft2  “^2  -«2l) 

+ll2ll6ll/2C08(-9,2  -02  -921  -922)  +  2«3M4(n  +  0rtK0*2  +/2)C08(-^) 

+2l#j«5(/l  +  0rt)/2C08(-fl2  -92i)  +  M6(W  +  0,iV2«K(-®2  -921  -  922) 

+2ll4ll3(<7»2  +/2)/2C0S(-^2i)  +  «4‘%(«*2  +/2)/2c06(-«21  -922) 

+ll5l<j/2^C08(-^22) 

V,2  =«i^(0*l  +/1)^  +«2^/l^  +«3^(/l  +  0rt)*  +«4*(0m  +/2)^  +«S*/2^  +«4*(/2  +  0,2  +<^f2)* 
+2ii,«2(o*,  +/l)/la»(-ft,)+2i^«3(04,  +/lKn+Oa)«»(-9ii  -912) 

+2tt,H4(o*,  +nXo*2  +<2)cos(-9„  -4,2  -e2)+2ii,ii5(o*,  +/l)/2cos(-4„  -4,2  -0-421) 
+2ttill4(04i  +/1X/2  +  o,2  +t«2)cos(-9ii  -4i2  -^-921  -922)  +  2M2«j/K/l+On)cos(-4i2) 

+2«2U4/1(Oa2  +^2)C0S(-4,2  -02)  +  2tt2“5^2cO8(-4j2  -O2  -421) 

+2«2««/1(/2  +  0,2  +ff2)«»(-9l2  -®2  -921  -922)  +  2%«4(/1  +  0„K<>*2  +/2)C08(-02) 

+2%Mj(/l  +  OrtX2COS(-02  -42,)  +  2ll3U4(/l  +  OrtX/2  +  0,2  -921  -922) 

+2U4«5(042  +/2)I2co8(-42,)  + 2114114(042  +/2X/2  + 0,2  +  c,2)cos(-42,  -422) 

+2UsU^l2il2  +  0^  +  C,2  )C08(-422  ) 

In  order  to  simplify  notation,  generalized  ii^rtia  terms  will  be  introduced  at  this  ^int 
The  generalized  inertia  terms  summarized  below  (for  the  6  DOF  TLA  configuration  only) 
wiU  be  used  in  the  Lagranian  development  for  the  dynamic  equations  of  motion. 


*^1 1  =  «*iC*i  +  ^*1  +  »«fi  [om  +  j]  +  la  +  (2mn  +  Wo  +  ««  +  +  "hi  K^h  +  nf 

Jn  =  ffhi  j  +  /„  +  (w,,  +  m,,  +  W42  +  3/n,2  +  w,2  +  Ai 

>^33  =  '"ii  J  j  +  hi  +  "*ii  +  <^ti  +  (^M  +  3m,2  +  m,2  )(/l  +  0,1  y 

J44  =  1^42^42  +  f*2  ^12^®*2  ■*"  hi  i^"hl  "^tl^io^l  ■*"  ^2) 

Jjj  =  hi  (^2 

^66  ~  hi  ^il  ft2)  hi 

Jii  =  ^[(3mn  +  2m,i  +  2m^2  +  ^»hi  +  2iii,2)(o«  +  /1)/1] 

Ai  =  +  2/n,i  (/I  +  0,1  +  c„ )  +  (2m42  +  6m,2  +  2m,2  )(/l  +  o,,  ))(o*j  +  /!)] 

/j4  =~[(2w42C42  +2/n,2(®*2  ((^^2  ■*'2m,2)(o42  +/2))(o4,  +/1)] 
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•/i5=}((3»^2+2«aXo„+/l)«] 

J\6  =  |i(W|2^2  +  2w,j(/2  +  o,j  +  c,j))(o*,  +  /!)] 

•^23  =  +  2w,i  (/I  +  0,1  +  c,i ) + (2#^2  +  6«,J  +  2m,j  xn  +  0,1  ))/ll 

1  n 

•^24  =  2l(2WkjC»j  +  2#n,j(o„  +y)  +  (4i»i,2  +  2m,jXo„  +/2))/ll 

4  =  ^[(3«,2/2(o„  + 11)  +  2m,2/2)/l] 

•^26  =  j[("^2^2  +  2m^  (12  +  0,2  +  Crt  )X1] 

1  12 

•^34  =  2  K2w*2C*2  +  2m, 2(0*2  +  y) + (4ii%2  +  2m,2  Xo«  +  /2))(/l + o,, )] 

•/3s=|[(3m,2+2m,2)/2(/l  +  o„)] 

•^36  =  ^[(«I2^2  +  2m,2(/2  +  0,2  +  c,2)Xn  +  ^>,i)] 

/♦s  ~  '^[(3^2  +  2m,2))^2(o*2  +  /2)] 

•^44  =  ^1(w»2^2  +  2m,2  (/2  +  0,2  +  c,2  )Xo*2  +  ^2)] 

/k  =  ^[(^2^2  +  2m, 2  (/2  +  0,2  +  c,2))I2] 

Using  the  generalized  inertial  terms  presented  above,  the  kinetic  energy  for  the  6  DOF 
system  may  be  represented  as 


+yj2«,«2  COS(tt,  -  »2  )  +  7,3lii«3  C0S(«1  -  «j)  +  7i4^«4  COS(Hi  “  »4  )  +  /i5«j«5  COS(«i  “  «5  ) 
+y,«U,li«00S(lli-H6) 

+y23«2«3  COS(«2  -  «j)  +  724H2«4  C0S(«2  “  «4)  +  725«i2«5  C08(«2  -  »5) 

+J26M2H6COS(<l2-«6) 

+734«3‘<4  COS(tt3  -  «4)  +  /35lii3«5  COS(«3  ~  «5)  +  '^36M6  C08(«3  -  Hg) 

+745«4«j  C0S(M4  -  «j)  +  74g«4«6  COS(«4  "  «6) 

+756H5HgCOS(Uj-Hg) 

The  potential  energy  developed  in  the  torsional  springs  is: 

V  =  ^k,(u^-Ui?  +^^(«3  -*<2)'  +  J*2(«5  +  j*2(“6  -«s)' 

Lagranges  equation  is  of  the  form  (Bl)  where  represents  generalized  forces  due  to  the 
element  torsional  s  damping. 
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dt  j  Sui 


(Bl) 


Cairying  out  this  operation  for  the  6  DOF  system,  the  following  equations  of  motion  were 
developed: 


hA+Jn>h  cos(-^,i)+ J,3ttjCos(-ft,  -4ij)  +  yi4«4Cos(-9ii  -flu  -^2) 

+/l5«5  COS(-fln  -(fyi  -62  -fl2l)‘*‘ A6‘^COS(-4i1  -^12  -6^  ~Q2\~9ll) 
+/t2«2Sin(-^„)+/,3«|sill(-^„  -flu)  +  -^14«4S“(-flll  -flu  -®2) 

+7,5«5  S“»(-flll  -flu  -fl2j)  +  '/l6«6  Sin(-flll  -flu  -®2  -fl21  -fl22) 

=  ki(qii)+bi(uj-Ui)+Ti 

y21«lCOS(-^„)  +  y22«2  +-^23“3«K(-fll2)  +  '/24«4<»S(-«,2  -^2) 

+725«J  C0S(-«,2  -  ^2  -  fl21 )  +  «»(-flu  -  ^2  "  fl21  -  fl22  > 

-72iIi?  sin(-flii)  +  723«3  sin(-^i2)+  724«4  sin(-«,2  -^2) 

+725«j  Sin(-fli2  -  ®2  -  fl2J )  +  •^2S«6  8m(-flu  -  ®2  -  fl21  -  fl22  ) 

—  — ^l^flll)  +  ^l(flu)  — +  — *2) 

73iHj  C0S(-^  1  -  flu  )  +  •^32*2  ®OS(-flu  )  "*■  ’^34^4  COS(-62  ) 

+733M5  COS(— ^2  —  fl21  )■*■  •^36*^6  COS{~02  — fl21  ~Qt2^ 

-J^iUi  siii(-^,  1  -  fli2 )  -  732«2  sin(-^,2) + 734«i  sin(-02 ) 

+735«|  Sin(-fl2  -fl2i)  +  73«m|  Sin(-02  -fl2i  -fl22) 

= -*1  (fll2  )  - («3  -  “2  )  -  ^ 

74, tt,  COS(-qi  1  -  flu  -  ^2  )+  -^42*^2  «»(-flu  -  ®2  )  +  •^43»3  COS(-02  ) 

+744«4  +  J^sU,  C08(-^21  )  +  74<i«j  COS(-921  -  fl22  ) 

-74,h{'  sin(-flu  -flu  -^2)-  A2«2  S>n(-fli2  -0)-  743«3  sin(-e) 

+743M5  sin(-?2i)  +  746«6  sin(-?2i  -  fl22) 

=  +42(921)'*' 1^2  ^**5  —  **4)  + 12 

■^sA  COS(-9n  -9i2  -$2  -fl2l)''''^S2‘^  COS(-9i2  -02  -fl2l)'''  753»3COS(-02  -fl2l) 
+754«4  COS(-92i)+  7jj«j  +  7j<;M6  C0S(-922) 

-75i«f  Sill(-9^  -9i2  -02  -fl2l)-'^52“2  S™(-flu  “^2  -fl2l)-/53**3  Sin(-02  -fl2l) 
-754«4  sin(-92i ) + Js6‘4  Sin(-fl22 ) 

—  — 42(fl2l)  +  42(fl22)—  1*2(‘‘3  “  *<4)+  1*2 (•*6  ”  **5) 

J^A  C06(-9ii  -  fli2  -  02  -  fl21  -  fl22)'*'  ■162*^  COS(-9i2  -  02  -  fl2i  -  fl22) 

+763M3  COS(-02  -  fl21  -  fl22  )  ■*■  ^64^*  COS(-921  “  fl22  )  COS(-fl22  )  /s6*^ 

-JeiUi  sin(-9ii  -912  -02  -921  -fl22)-/s2®2 sin(-9i2  -02  -921  -922) 

-763«|  sin(-02  -  fl2i  -  fl22)-  ''64«4  sin(-fl2i  -  fl22)-  sin(-922) 

—  —42(922)  — 1*2  (**6  —  **3) 


Appendix  C:  Model  Poles  and  Zeros 
Full  model  poles 


1.0000 

1.0000 

0.9219  +  0.3688i 

0.9219  -  0.3688i 

0.4687  +  0.8274i 

0.4687  -  0.8274i 

-0.1270  +  0.88371 

-0.1270  -  0.8837i 

-0.5232  +  0.67231 

-0.5232  -  0.67231 

-0.7090  +  0.43541 

-0.7090  -  0.43541 

-0.7811  +0.26321 

-0.7811  -0.26321 

-0.8092+0.13931 

-0.8092  -  0.13931 

-0.8718 

-0.9416 

-0.7709 

-0.9665 

-0.9790 

-0.9o60 

-0.9903 

-0.9929 

-0.9946 

-0.9958 

-0.9972 

-0.9965 

-0.9970 

-0.7127 

-0.6937 

-0.6846 

-0.6795 

-0.6765 

-0.6746 

-0.6734 

-0.6726 

-0.6718 

-0.6716 

-0.6721 


0.9219  +  0,36881 
0.9219-0.36881 
0.4687  +  0.82741 
0.4687  -  0.82741 


Poles  reduced  model 
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-0.1287  +  0.8806i 
-0.1287  -  0.88061 
-0.5779  +  0.61161 
-0.5779  -  0.61161 
1.0000  +  0.00001 
1.0000  -  0.00001 


Zeros  of  Reduced  System 

n=l 


ans  = 

-1.0000 

-0.5362  +  0.64741 
-0.5362  -  0.64741 
0.0038  +  0.90421 
0.0038  -  0.90421 
0.7576  +  0.61751 
0.7576  -  0.61751 
0.9960  +  0.08071 
0.9960  -  0.08071 
1.0000 

n=2 


ans=: 

-1.0000 

-0.4373+0.78411 
-0.4373  -  0.78411 
0.2227  +  0.92731 
0.2227  -  0.92731 
0.9065  +  0.44201 
0.9065  -  0.44201 
1.1025 

1.0000  +  0.00001 
1.0000  -  0.00001 

n=3 

ans  = 

-1.0000 

-0.4581  +  0.65201 
-0.4581  -  0.65201 
0.1342  +  0.89111 
0.1342  -  0.89111 
0.8608  +  0.45461 
0.8608  -  0.45461 
0.9452 

1.0000  +  0.00001 
1.0000  -  0.00001 


n  =  4 


ans  = 

-1  noon 

0.0223  +  0.87481 
0.0223  -  0.8748i 
-0.5206  +  0.3255i 
-0.5206  -  0.32551 
0.8174  +  0.4686i 
0.8174  -  0.4686i 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.8762 

n  =  5 

ans  = 

-1.4463 

-1.0000 

-0.0766  +  0.88381 
-0.0766  -  0.88381 
0.7867  +  0.50961 
0.7867  -  0.50961 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.8986 
-0.1107 

n  =6 


aiis  = 

-3.3932 

-1.0000 

-0.1547  +  0.86771 
-0.1547  -  0.86771 
0.7769  +  0.57391 
0.7769  -  0.57391 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.9736 
-0.0700 

n=7 


ans  = 

37.0422 

-1.0000 

-0.2114  +  0.80761 
-0.2114  -  0.80761 
0.7677  +  0.65241 
0.7677  -  0.65241 
1.0579 

1.0000  +  0.00001 

1.0000  -  0.00001 
-0.1427 


n  =  8 


ans  = 

3.2727 

-1.0000 

-0.2393  +  0.70831 
-0.2393  -  0.70831 
0.7158  +  0.74111 
0.7158  -  0.74111 
1.1348 

1.0000  +  0.00001 
1.0000  -  0.00001 
-0.2552 

n  =9 

ans  = 

2.0600 

-1.0000 

0.5948  +  0.79621 
0.5948  -  0.79621 
-0.2336  +  0.55341 
-0.2336  -  0.55341 
1.1768 

1.0000  +  0.00001 
1.0000  -  0.00001 
-0.4071 

n*10 

ans  = 

1.8731 

-1.0000 

0.4384  +  0.81731 
0.4384  -  0.81731 
1.1424 

1.0000  +  0.00001 
1.0000  -  0.00001 
-0.7084 

-0.1438+0.27571 
-0.1438  -  0.27571 

n=ll 

ans  = 

1.9851 

0.2871  +0.86701 
0.2871  -  0.86701 
-1.1711 
1.0562 

1.0000  +  0.00001 


1.0000 -O.OOOOi 
-1.0000 
0.3401 
-0.3808 

n=12 

ans- 

-1.8434 

2.2340 

-1.0000 

0.1725  +  0.91581 
0.1725  -  0.91581 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.9506 
0.6072 
-0.5093 

n=13 

ans  = 

-3.2719 

2.5785 

-1.0000 

0.0632  +  0.92841 
0.0632  -  0.92841 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.8129  +  0.10451 
0.8129  -  0.10451 
-0.6002 

n  =14 

ans  = 

-8.5635 

2.9285 

-0.0480  +  0.88971 
-0.0480  -  0.88971 
-1.0000 

0.8292  +  0.16941 
0.8292  -  0.16941 
1.0000  +  0.00001 
1.0000  -  0.00001 
-0.6783 


n=15 


ans  = 
-80.2913 
2.8908 


-0.1512  +  0.79251 
-0.1512  -  0.79251 
-1  onno 

0*8360  +  0.18151 
0.8360  -  0.18151 
1.0000  +  0.00001 
1.0000  -  0.00001 
-0.7538 


n=16 


ans  = 

-37.8924 

2.2999 

-1.0000 

-0.8513 

-0.2462  +  0.61321 
-0.2462  -  0.61321 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.8353+0.15461 
0.8353  -  0.15461 

n=17 

ans  = 

-7.4878 

1.7132 

1.0000  +  0.00001 
1.0000  -  0.00001 
-1.1745 
0.9357 
-1.0000 
0.7148 

-0.2925+0.11131 
-0.2925  -  0.11131 

n=18 

ans  = 

-2.0521  + 1.38661 
-2.0521  - 1.38661 
-1.0000 
-0.7280 

1.1947  +  0.20691 
1.1947  -  0.20691 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.4193  +  0.24551 
0.4193  -  0.24551 


n=19 


ans  - 

-1.2694  +  1.8730i 
-1.2694-1.87301 
-1.0000 
-0.7990 

1.0954  +  0.34601 
1.0954  -  0.34601 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.4804  +  0.42891 
0.4804  -  0.42891 

n=s20 

ans  = 

-0.8774  + 1.94401 
-0.8774  - 1.94401 
-1.0000 
-0  8335 

0.5182  +  0.54071 
0.5182  -  0.54071 
1.0213  +  0.38331 
1.0213  -  0.38331 
1.0000  +  0.00001 
1.0000  -  0.00001 


ans  = 

0.0045  +  0.90451 
0.0045  -  0.90451 
-0.5351+0.64921 
-0.5351  -  0.64921 
0.7582  +  0.61771 
0.7582  -  0.61771 
0.9964  +  0.08071 
0.9964  -  0.08071 
-1.0079 
-1.0000 


ans  = 

0.2056  +  0.90631 
0.2056  -  0.90631 
-0.4304  +  0.74611 
-0.4304  -  0.74611 
0.8879  +  0.43791 
0.8879  -  0.43791 
-1.0000 

1.0000  +  0.00001 
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1.0000  -  O.OOOOi 
-0.8955 

n  = 

23 

ans  = 

-1.0941 

-1.0000 

-0.4623  +  0.68921 
-0.4623  -  0.68921 
0.1478  +  0.90521 
0.1478  -  0.90521 
0.8741+0.46141 
0.8741  -  0.46141 
1.0000  +  0.00001 
1.0000  -  0.00001 

n=24 

aiis  = 

-1.4097 

-1.0000 

0.0695  +  0.89881 
0.0695  -  0.89881 
-0.5004  +  0.57941 
-0.5004  -  0.57941 
0.8553  +  0.49101 
0.8553  -  0.49101 
1.0000  +  0.00001 
1.0000  -  0.00001 


n=25 

ans  = 

-2.0625 

0.8289  +  0.52911 
0.8289  -  0.52911 
1.0000  +  0.00001 
1.0000  -  0.00001 
-0.0312  +  0.88541 
-0.0312  -  0.88541 
-1.0000 

-0.5286  +  0.35611 
-0.5286  -  0.35611 

n=26 


aiis  = 
-3.8851 
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-1.0000 
.n  800') 

-0.1420  +  0.86281 
-0.1420  -  0.86281 
0.7909  +  0.57851 
0.7909  -  0.57851 
1.0000  +  0.00001 
1.0000  -  0.00001 
-0.1885 


n-27 


ans  = 

-18.4715 

-1.1711 

-1.0000 

-0.2419  +  0.82381 
-0.2419  -  0.82381 
0.7355  +  0.64121 
0.7355  -  0.64121 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.0672 

n  = 

28 

ans  = 

8.5008 

-1.3747 

-1.0000 

-0.3257  +  0.76431 
-0.3257  -  0.76431 
0.6558+0.71491 
0.6558  -  0.71491 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.2274 

n=29 

ans  = 

3.8912 
-1.5386 
-1  noon 

-o!4022  + 0.68161 
-0.4022  -  0.68161 
0.5496  +  0.78791 
0.5496  -  0.78791 
1.0000  +  O.OOOOi 
1.0000  -  0.00001 


0.3405 


n=30 


anss 

2.7544 

-1.6497 

0.4252  +  0.8460i 
0.4252  -  0.8460i 
1.0000  +  0.0000i 
1.0000  -  O.OOOOi 
-1.0000 

-0.4851  +0.5622i 
-0.4851  -  0.5622i 
0.4215 

n  =  31 

ans  = 

2.2717 

-1.6581 

0.2945  +  0.88431 
0.2945  -  0.88431 
1.0000  +  0.00001 
1.0000  -  0.00001 
-1.0000 

-0.5997  +  0.34261 
-0.5997  -  0.34261 
0.4801 

n=32 

aiis  = 

2.0147 

-1.3683+0.28341 
-1.3683  -  0.28341 
0.1630  +  0.90361 
0.1630  -  0.90361 
1.0000  +  0.00001 
1.0000  -  0.00001 
-1.0000 
0.5240 
-0.3205 

n=33 

ans  = 

-1.5365  +  0.65581 
-1.5365  -  0.65581 
1.8581 
-1.0000 

0.0306  +  0.90171 


0.0306  -  0.9017i 
1.0000  -t-  O.OOOOi 
1.0000 -O.OOOOi 
0.5579 
-0.1590 

n=34 


ans  = 

-1.6747  +  0.90691 
-1.6747  -  0.90691 
1.7544 
-1.0000 

-0.1051  +0.87071 
-0.1051  -  0.87071 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.5847 
-0.0745 


n=35 


ans  = 

-1.8549+1.09991 
-1.8549  - 1.09991 
1.6822 
-1.0000 

-0.2445  +  0.79891 
-0.2445  -  0.79891 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.6061 
-0.0254 


n=36 


ans  = 

-2.2028  + 1.12231 
-2.2028  -  1.12231 
1.6304 
-1.0000 

-0.3923  +  0.66881 
-0.3923  -  0.66881 
1.0000  +  0.00001 
1.0000  -  0.00001 
0.6232 
0.0016 


n=37 


aiis  = 
-4.2350 
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-1.9434 
1.5923 
-1  nnon 

-0!6074  +  0.3680i 
-0.6074  -  0.3680i 
1.0000  +  0.00001 
1.0000  -  O.OOOOi 
0.6369 
0.0104 

n=38 


ans  = 

-15  9546 
-1.2629  +  0.76331 
-1.2629  -  0.76331 
-1.0000 
1.5624 

1.0000  +  0.00001 
1.0000  -  0.00001 
0.6483 
-0.1235 
-0.0235 


n=39 


an$s 

15.3484 

-1.2533  + 1.00411 
-1.2533  -  1.00411 
-1.0000 
1.5334 
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n5=41 

ans  = 

-5.6194 

1.6385 

-1.3450  +  0.95881 
-1.3450  -  0.95881 
-0.2103  +  0.83791 
-0.2103  -  0.83791 
-1.0000 
0.6248 

-0.0871+0.15391 
-0.0871  -  0.15391 

n=42 

ans  = 

-5.6194 

1.6385 

-1.3450  +  0.95881 
-1.3450  -  0.95881 
-0.2103  +  0.83791 
-0.2103  -  0.83791 
-1.0000 
0.6248 

-0.0871+0.15391 
-0.0871  -  0.15391 


[gp]  u|eg  [Bag]  asegd 


Figure  D.l  Open  Loop  On-Deslgn  Bode  Plot 
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Figure  D.3  Open  Loop  On-Design  Root  Locus 
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[ap]  U|e9  [6aa]  agegd 


Figure  D.4  Closed  Loop  PID  On-Design  Bode  Plot 
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Figure  D.5  Closed  Loop  PID  Off-Design  Flexible  Link  Bode  Plot 
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Figure  D.6  Closed  Loop  PID  On-Design  Root  Locus 
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